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(57) Abstract 

A system for determining the position and orientation of a moveable object in space relative to a stationary object has two transmitter 
units mounted in fixed, spaced relationship on a stationary console and two receiver units mounted on a headset or other moveable object. 
Each transmitter unit has a triplet of orthogonally arranged LEDs, each of which generates a hemispherical beam of radiation. Each receiver 
unit has six photodeiectors (A-F), each of which has a plane of sensitivity such that the intensity of incident radiation is proportional to the 
cosine of the angle of incidence of the radiation. The six photodetectors are arranged such that they form four sets of three photodetectors 
with the photodetectors in each set having their planes of sensitivity arranged orthogonally. Each of the photodetectors generates a direction 
cosine signal proportional to the intensity of radiation received from each LED. The radiation is pulsed infrared radiation and each LED in 
turn is pulsed for a pre-set time period. Each photodetector is monitored sequentially during energisation of each LED to obtain a direction 
cosine signal for the ladiadon incident at each photodetector in turn from each LED in turn. The resulting signals are processed to determine 
the position and orientation of the headset in space relative to the LEDs. 
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POSITION SENSING USING INTENSITY RATIOS 

Field of the Invention 

This invention relates to a method and apparatus for determining the relative position and/or 
orientation of two objects in space and for monitoring changes in said relative position. 

Description of the prior art 

There are many xises for such a method and apparatus, one of them being to inform a 
computer about the position and/or orientation of a physical object such as the head and/or 
other members of a human body in circumstances in which the computer is generating 
images which take account of movements of the person viewing such images. Applications 
of inunersive virtual reality in the entertainment and other fields are examples of such 
circumstances, A person experiencing inmiersive, interactive virtual reality wears a headset 
by means of which computer generated images are presented to his eyes and accompanying 
sounds are presented to his ears. These images and sounds are varied by the computer in 
accordance with inovements of the headset wearer's head so that realism is maintained. 

Many position sensing proposals have been made in the past but ail have drawbacks either 
of cost of the equipment employed or of complexity of the computations involved which 
adversely affect the computer response time. 

Brief summary of the Invention 

The present invention seeks to provide an improved method and apparatus for determining 
the relative positions and/or orientation of two objects in space. 

A system for determining the relative positions of first and second objects in space in the 
azimuth and vertical directions wherein one of said objects is stationary and the other of said 
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object is moveable in space, the system comprising: 
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transmitter means on said first object for generating a radiation beam; 

receiver means on said second object for receiving radiation transmitted by said transmitter 
means; 

wherein either: 

a) said transmitter means comprises three transmitters in a fixed, spaced relationship 
to one another for generating respective radiation beams; or 

b) said receiver means comprises three receivers in a fixed, spaced relationship to one 
another for detecting said radiation; 

and vrherem the or each said receiver has a plane of sensitivity such that the intensity of 
incident radiation is proportional to the cosine of the angle of incidence of said radiation; 

the system further comprising: 

means for monitoring S£dd intensity of the radiation incident at the or each said receiver from 
the or each transmitter and generating a respective direction cosine signal proportional to said 
intensity; 

and micro processor means operable to detemiine from said signals a pointing vector of said 
moveable body from said stationary body. 

The preferred system according to the present invention uses wide angle beams of infra red 
(IR) light to measure relative pointing angles. It does not use the intensity of the IR beam 
but uses the polar distribution of IR energy from each IR transmitter and the relative intensity 
of triplets of transmitters. 
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The amoiint of light emitted from (or received by) the small rectangular surface of an LED 
(or photo diode) transmitter is abnost perfectly circular. Therefore, as the aperture angle 
increases from 0° to 90* the energy transmitted closely follows a cosine response. 

Consider two IR transmitters (or receivers) mounted at 90° to one another with half of the 
light from each transmitter overlapping the other to form a 90° cone. Within this cone a 
receiver receives an amount of light from each transmitter. The ratio of these two amounts 
is related to the angle at which the receiver is situated relative to the transmitters. Since the 
two LED's produce cosine polar plots and since they are 90° "out of phase" the two 
dimensional angle at which the receiver is situated is given by the ratio of the amount of light 
received from the transmitters. Siace we are dealing in ratios rather than absolute amplitudes 
the effects of distance can be ignored. 

Now consider three LED's, mounted at 90° to one another. For any line of sight within the 
octant that can "see" all three transmitters, the ratio of the readings can be used to give the 
three-dimensional direction cosine of the line of sight. This line of sight region defines an 
octant of usable field of view. 

If two or three receivers are used, mounted orthogonally, the two-dimensional or three- 
dimensional angle between the boresight of tiie receivers and the line from the receivers to 
the transmitters can be measured (Figure 2). By calculation, we therefore have the angle z 
of the receiver location relative to a base line of the transmitter LEDs. The arrangement is 
symmetrical, with ratios of LED intensity received at any receiver giving the LED angle x 
and the ratios of receiver intensity from any LED giving the receiver angle y . 

Brief description of the drawings 

The present invention is further described hereinafter, by way of example, with reference to 
the accompanying drawings, in which: 
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Figure 1 is a diagrammatic illustration of the relationship in use between an LED light source 
and an arrangement of three orthogonal photodetectors; 

Figures 2 and 3 are diagrams illustrating the mathematical principles involved; 

Figure 4 is a diagrammatic configuration illustrating the principles of a preferred system 
according to the present invention; 

Figure 5 is a diagrammatic representation of a photodetector block for the system of Figure 
^' 

Figure 6 is a diagrammatic representation in plan of the photodetectors of the system of 
Figure 4; 

Figures 7a and 7b are further diagranmiatic configurations illustrating the principles of a 
preferred system according to the present invention; 

Figure 8 is a diagrammatic plan view of a practical system according to the present invention; 

Figure 9 is a side elevation of the system of Figure 8; 

Figure 10 is a plan view of a transmitter unit for the system of Figure 8; 

Figure 11 is a plan view of a photodetector block for the system of Figure 8; 

Figure 12 is a perspective view of the photodetector block of Figure 11; 
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Figure 13 is a diagrammatic plan view illustrating the positions of two of the photodetector 
blocks of Figure 1 1 moxmted on a head set; 

Figure 14 is a pulse timing diagram illustrating the operation of the system of Figure 8; 

Figure 15 is a circuit diagram of the transmitter units of the system of Figure 8; 

Figure 16 is a block circuit diagram of the control and processing circuitry of the system of 
Figure 8; 

Figures 17 and 1 8 are pulse timing diagrams illustrating the operation of the circuit of Figure 
16; 

Figure 19 is a diagram illustrating the maimer in which information is processed by the 
circuit of Figure 16; and 

Figure 20 is a diagram illustrating the total azimuth field of view provided by the two 
photodetector blocks of Figure 13 . 

Detailed Description 

Figure 1 shows a light source LS which conveniently is an LED 80 projecting fi-om a surface 
82 such that it dififiises light generally uniformly throughout a hemisphere. This is as 
distinct from the relatively expensive light sources of some prior art proposals which have 
required parallel beams of collimated light. Three planar photodetectors, only two of which 
84 and 86 are visible in Figure 1, are moimted on orthogonally-related surfaces such as 88 
and 90 of a cube 92. The three photodetectors are mounted orthogonally (xyz directions) 
such that for the purposes of the measurement they may be treated as being at the same point. 
The position of the light source is determined by measuring the relative intensity of light 
from the source incident on each of the three detectors. The total intensity of the light at the 
position of the detectors may be eliminated using simple mathematics. Three direction 

RECTIFIED SHEET (RULE 91) 
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cosines may thus be obtained which define the direction of the light source from the position 
of the detectors. The three photodetectors are connected to a microprocessor and provide it 
with infoimation as to the relative position in space at any given moment of the light source 
LS and the cube P according to the intensity of the light from source LS which falls on each 
of the photodetectors. 

References throughout to light sources and to photodetectors are to be taken to. include other 
forms of electromagnetic radiation and to means for detecting the same. 

Referring to Figure 2, the intensity I of electromagnetic radiation measured from a constant- 
intensity source such as the LED 80 is the product of the Intensity I^, of the radiation falling 
upon the photodetector 84 or 86 when at right angles to the direction of radiation and the 
cosine of the angle 0 between the source direction and the normal N to the plane of the 
detector. As illustrated in Figure 2: 

I = I COS0 = I .N 

Where: 

lo = the Intensity of the radiation falling upon the photodetector when the 
photodetector is at right angles to the direction of radiation, 

e = angle of incidence of the radiation, 

I = the Intensity of the radiation falling upon the photodetector when the 
photodetector is at the angle 6 to the direction of radiation, 

Referring to Figure 3, using two such planar photodetectors 84, 86 at right angles to one 
another and with the direction to the source of radiation in the plane formed by the detector 
normals, N|, N2, the direction vector T (bearing) of the source can be obtained with respect 
to the bisector of the angle between the normals N,, in the plane, using simple 
trigonometry. 
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The value of the intensity can be eliminated from the computation, without affecting its 
accuracy, using the ratio of the two intensities measured. The use of the ratio also means 
that the distance between the source LS and detector array P is not a factor in the equation. 
Thus from Figure 3 : 



Lcose, cos©, 
ratio r " * ' 



1^00582 cosS, 



but if vector T from the target source LS is in the same plane as the normals N, & Nj, then: 

V - 45* . ©. 



'I 



also V • -45® ♦ ©J 



Hence: 

I cos(45° - v) ^ cos 45° cos v sin 45° sin v I 1^ tan v 
cos(45° ♦ v) cos 45*» cos v - sin 45® sin v 1 - tan v 

so 

tan v « .^-I-i 
r ♦ 1 

However, if the direction vector T to the light source LS is not in the same plane as the 
normals Ni, N2 of the photodetectors the equations relating the angles do not hold and there 
is a more complex relationship. Using two of the photodetector pairs with their axes at right 
angles to each other gives a complex set of relationships between the measured ratios from 
which it is difficult to disentangle the bearing angles to get a true 3 dimensional bearing 
vector. 
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Therefore, instead of using a pair of 2 dimensional devices to try to measure in 3 dimensions 
the configuration of three detectors in orthogonally-related planes illustrated at P in Figure 
Ic is provided. The use of this simplifies the measurement and reduces the computation 
heeded to obtain the desired result. 

The principle of the 2 dimensional configuration is to get a pair of results at the same time 
to enable variations in the measured intensity of the light source to be eliminated by taking 
ratios. If three results are used, however, the ratio method will not work and another way 
must be found to eliminate the effects of light intensity variation. 

The normals of the planes of the three photodetectors 82, 84 are arranged to lie along the 
principal axes x, y, z of an orthogonal cartesian set. With this arrangement the cosines of 
the angles which the direction vector I makes with the plane normals is a set of direction 
cosines so the sum of their squares will be unity. The measurement can therefore be 
nomialised by squaring and adding the measured quantities and then dividing each by the 
square root of the sum to obtain a set of 3 dimensional direction cosines. 

Referring again to Figure Ic, the nozmals can be considered as a right handed set of cartesian 
axes taken in the order x, y, z. Each intensity measurement, when taken at the same time, 
is the product of the light wavefront intensity and the appropriate direction cosine, as follows: 

r, - cos 
r^ - lo cos 

\ COS 

To eliminate the wavefront intensity Iq, the three values are squared and added: 

r/ ♦ ry * r/ - lo* (cos' 0^ ♦ cos* ♦ cos* 0^) 

but by definition: 

cos* 0^ * cos* ♦ cos* 0^-1 
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Hence: 

So the wavefront intensity can be calculated and eliminated from the measurements by 
division, leaving a set of direction cosines defining a unit vector from the photodetector triad 
towards the source LS in the given set of orthogonal axes. These axes can be rotated into any 
other cartesian space as required using general mathematical techniques to give a pointing 
vector in Virtual Space. Using the vectors to two infra red light sources in the real world 
enables a head-up vector to be defined and used for a three degrees of freedom tracking 
system. The head-up vector is normal to the pointing vector and the plane of the pointing 
vector defined by the two light sources and the photodetector triad. 

Refeiring now to Figures 4 to 6 these represent a system having a single point source of light 
and two groups of photodetectors. 

In Figure 4, the point P represents a source of light, and the points V| and V2 represent the 
positions of two groups of detectors fixed in a predetermined spaced relationship on a 
console. The light source at P acts like a point source and emits light with a cosine-like 
wavefront. Detector groups V, and are sets of orthogonal detectors that are arranged such 
that the ratio of intensities incident on them will, using simple mathematics, yield the 
direction of the light source. 

Consider the figuration in Figure 4 where the console detectors are deployed at V, and V2, 
which are known points and pointing directions in the reference frame of the system. What 
is required for the tracking system is the position of P in the reference frame and the pointing 
and head-up vectors of the target being tracked. 

Finding the point P 

1. The bearing of P is measured from V|, giving the direction P - Vj. 

2. The bearing of P is measured from Vj, giving the direction P - V^. 



wo 96/35960 PCT/GB96/0H41 

10 

3. The points of closest approach are calculated of the vectors defined by these two 
bearings. The point P is the mid point of the vector joining these two points. 

Finding the Pointing and Head-up Vectors 

Using the moving frame of reference of the target P:- 

1 . From the target, measure the bearing angles to V, and respectively. 

2. Calculate the direction of the vector from the target at right angles to Vj - V,. 
(Pointing vector) 

3. Calculate the normal to the vectors V, - P and V2 - P. (Head-up vector) 

4. From these two vectors construct the inverse of the rotation matrix. 

5. Invert this matrix to give the rotation matrix, containing the pointing and head-up 
vectors in the original reference frame. 

Theory 

Finding the position (bearing) of target P 

Measuring the bearings t, and of the target P from V, and Vji 
Let 

Pt-V, + at, 

and 

P, = V, + bt, 

The point of nearest approach of these two vectors is calculated as follows:- 
The normal to vectors t, & tj 

n = t, X tj (normalised) 

so 

P = 0.5 (P, + P2) = V, 4- at, + 0.5/n = + bt^ - 0.5/n 
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where 

/=|P2-p.l 

hence 

Vj-V, = at,-btj + /n 



i.e. 





tu n« 




a 






- v,x 






K K ^ 




-b 












t,. ^ \ 




/ 










a 






^x 


-1 


CV2 


- V,), 


-b 














. /. 




. tjz ^ 




.(^2 





If V2 - V, is lined up with the x-axis as shown in Figure 1 then (V2 - V,)y and (V2 - V,)^ are 
both zero. 

Angular Degrees of Freedom 

To determine the orientation of the headset, the direction from the source to each of the two 
detector groups are measured. Using these directions, a vector from the source which is 
perpendicular to the line connecting the two detector arrangements is calculated. The 
direction of the vector normal to the plane defined by the soiu-ce and the detectors is 
calculated. A third vector, normal to the previous two vectors is also calculated. These three 
vectors define a set of orthogonal axes which characterise the orientation of the headset. 

The mathematical description of the above calculation is as follows:- 



Measure the bearing angles of V, and from P in the moving coordinate system, getting 
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unit vectors g| and gj. 

Let the head-up vector be h, where:- 

h = gi X g2 (nonnalised) 
and the pointing vector be p, where :- 

p = Ag, + Bg2 

A and B are obtained ftom the relationship calculated from the base position of the pointing 
vector and the two vectors P - V, and P - Vj, as follows > 

Let g'l = V, - P (normalised) 

and g'2 = Vj - P (noraialised) 

and O =P ^Py 

then O-F =p (normalised) 

so p' = Ag'i +Bg'2 

so A =-B(gVg'ix) or B = -A(g',^/g'2K) 

and B = -pV.g\x/(-gWg'ly + g'2y.g'.x) or A - -pVgVCg'jx-g'.y - g'2y.g'lx) 

Then 

b = pxh 

Then the rotation matrix which is used to rotate the moving axes into alignment with the 
fixed axes is constructed by using the elements of b, p (pointing vector) and h (head-up 
vector) taken in this order to make the rows of the matrix. 

b b b 

P. P, P. 
h. h,h. 

This matrix must be the inverse of that which rotates the axes of the fixed coordinate system 
into that of the headset, which is therefore:- 
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K P. K 

Py \ 

\ P. K 



The pointing and head-up vectors are calculated with respect to the plane defined by P, V, 
and V2. In practice, this may not be the azimuthal plane, but have an offset angle ^ defined 
by the headset design, vrhich will necessitate a rotation of the pointing and head-up vectors 
into the world coordinate system. 



Coordinate Systems 

The console devices from which the bearings to P are measured each has its own coordinate 
system. The relationships of these coordinate systems to the viewer world coordinate 
systems are fixed by the placement of the console imits on their mat. A rotation matrix is 
made for each point to rotate the local axes into line with the world system. 



The axes are defined as follows:- 
forV, 



-sA, 



-sEj.cAj 



-cA. 



cEj.cAj -cEj.sA, sE, 
cE, 



sE,.sA, 



see Figure 7a 



forVi 



-sA, 



cEj.cAj 



-cA, 



-cEj.sAj sEj 



-sEj.cA, sEj.sAj cEj 



see Figure 7b 



wo 96/35960 PCT/GB96/01141 

14 

Where s and c are sine and cosine respectively, and E and A are elevation and azimuth angles 
The negative signs for A, and A2 have been taken into account in the matrices. 
Calculations from Measurements 

From V, and Vj, the console devices, pairs of bearing vectors t, and t^, right and left are 
measured and from the detector in the moving target, two vectors g, and are measured. 

The following calculations are made- 

Add t, right and left together and normalise to get t|'. 
Add tj right and left together and normalise to get tj'. 

The Azimuth and Elevation angles of the boresight at V, are used to get the rotation matrix 
[r,] and similarly for Vj. 

Calculate (ril.t, and [r^J-t^ to get t, and tj respectively. 
Then 

n = t, X t^ (normalised) - 

and 

D = ti^.(t2y.n^.t2,.ny) 
W(t|z-ny - t,y.nj 

+ nx-(t|y-t22 " t,j.t2y) 

so 

a = (1/D).(t2yji, . t2,.ny).(V2 - V,)x 
/ = (1/D).(t,,.t2y - t,y.t2j.(V2 - V,)x 

giving 

P = V, + a.t, + 0.5/.n 
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Pointing Angles 



Let g', = V,-P 
and g'a^Vj.P 



(normalised) 
(normalised) 



calculate 




and 



so 



p = Ag, +Bg2 
and h = g| x g2 (normalised) 
b = pxh 

Four sets of three orthogonal detectors are used at each of the points V, and Vj. The 
detectors are arranged on a D-shaped block as depicted schematically in Figure 5 and 
described in more detail below. Each of the faces of the D-shaped block accommodates a 
single detector . In Figure 5, detectors 5 & 6, and 4 & 7 are orthogonal pairs: These pairs 
may be used in combination with either of detectors 0 or 1 to form four sets of three 
orthogonal detectors. 

Each of the four sets of detectors at points V, and measures in turn the intensity of the 
point light source. The orthogonal set of detectors at each of V, iand Vj that returns the 
greatest total signal is used to determine the vectors which define the position of the source. 

Detector pairs 5 & 6 and 4 & 7 are positioned at an angle of ten degrees relative to each 
other. Thus, octants described by these pairs when used in connection with detectors 0 and 
1 overlap by 10 degrees. When the light source is in the field described by this overlap, its 
position is determined by both sets of detectors. The position of the source as measured 
using both sets of detectors is compared. This removes the possibility of a discontinuity in 
the calculated position of the source upon transition between octants. The 10 degree angle 
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between the detector pairs also confers a second important benefit. Measurement of a 
directional cosine by any given detector will become inaccurate when the angle subtended 
by the source relative to the detector normal approaches ninety degrees. This is because the 
intensity of light incident on the detector is very low. The ten degree angle between detectors 
4 and 6 reduces the maximum angle subtended by the light source to either of the detectors 
to 85". 

Detectors 0 and 1 face in opposite directions. Therefore, the fields that they describe in 
combination with the other detectors of the group do not overlap. A possible discontinuity 
in the determination of the position of the source as it crosses between the two fields is 
removed by orienting the two detector groups as shown in Figure 6. The D-shaped detector 
groups are arranged so that detectors 0 and 1 are vertical. There is an angle of 135 * between 
the bases of the detector groups. In this formation, there is considerable overlap between the 
fields covered by the two detector groups. In particular, when the detectors are mounted on 
a headset, discontinuities will be avoided when the source is in the region directly in front 
of the headset. This is important as the source will be in this position for the majority of the 
time over which the headset is used. 

A person wearing the headset is unlikely to be on a plan level with a console containing the 
light source. Accordingly, the two D-shaped detector blocks are angled downwards towards 
the source at 45**, 

The theory of operation of the source and headset requires a smgle point source of light. In 
practice however, to provide a sufficiently strong optical intensity over the required area, 
three wide angle light emitting diode sources are used. The diodes are arranged so that they 
emit light that appears to come firom a common source. 

Non-Orthogonal Detectors 

The generation of three direction cosines of the bearing vector using three detectors depends, 
in the above derivation, on the three detectors being mutually at right angles to make an 
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orthogonal set. This constramt can be removed by using a set of modification matrices, one 
for each set of three non-orthogonal detector readings taken. 

The modification matrix is derived as follows:- 



Let r,, T2 and rj be the three readings taken 

then r, = lo-cos ©, where Iq is the IR light amplitude and 0, the angle between the 

bearing vector and the detector unit normal n. 

Let the unit vector in the bearing direction be v 
then r, = lo-v-nj 

similarly r2 = lo-v.nj and r3 = Io.v.n3 

















a 























SO 



i.e. 
so 

normalising 



R-INJ.vJo 
[N]-".R = v.Io 
.lo gives V. 



Clearly if the detector normals are orthogonal [N] is a rotation matrix and if they are lined 
up with the world axes, then [N] = [I] the unity matrix. 
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Example of a Set of Non-Orthogonal Detectors 
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Consider a regular dodecahedron. This solid has twelve faces, each of which is a regular 
pentagon. If each face contains a detector, then each set of three* detectors grouped around 
a vertex can be used to get a bearing of a target anywhere in the surrounding space. 

There are twenty vertices so it would be necessary to pre-compute the modification matrices 
for each set of detectors grouped aroimd a vertex, giving twenty matrices at maximum. For 
a more limited coverage, this number could be reduced. 

For instance, if one face were to be used to mount the device on the target, only eleven 
detectors woxild be needed and fifteen modification matrices. 

The angles between pairs of adjacent normals are 64% givmg a good overlap to prevent the 
necessity for measuring small signals, and giving good noise inmiunity. 

Refering now to Figure 8 this is a plan view of part of the preferred system having two 
transmitter imits 10, 12 and a receiver station in the form of a receiver headset 40 which, in 
use, is wom by a user of the system and which carries two receiver units 50, 52. Figure 9 is 
a side elevation of the system of Figure 8 showing the transmitter imits mounted on a console 
13. It will be appreciated that whilst a headset is referred to, the receiver station may be any 
movable object, e.g. a joystick. In addition, although the receiver units are described as being 
on the movable object and the transmitter xmits stationary, this may be reversed with the 
transmitter units on the movable object and the receiver units stationary. 

Referring firstly to the transmitter units 10, 12 these are arranged at the same horizontal level 
on the console 13 along an arbitrary base line 14 so that when the user is standing or sitting 
in the normal or base position of use 16 the transmitter units are below and approximately 
equi-distant from the centre of the headset 40. 

Each transmitter unit comprises a 3-sided pyramid 1 1 (Figure 10) in which each side face 18, 
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20» 22 of the pyramid is at right angles to each adjacent side. In effect, each pyramid is the 
comer of a cube. 



Figure 1 0 is a plan view of one transmitter unit 1 0 (the other transmitter unit being identical) 
showing the three side faces 18, 20, 22 of the psnramid. Each side face carries a transmitter 
24, 26, 28 in the form of a light emitting diode (LED) arranged such that its "cone" of 
transmission has an axis which is at right angles to the plane of the associated side face and 
to the base line 30, 32, 34 of the associated side face. The angles of the apexes of the three 
side faces are identical and typically 90" such that the "cones" of light from the LED's 
overlap. The axes of transmission intersect. It will be appreciated, of course, that although 
the LEDs are described and shown here as being arranged orthogonally, this is not essential. 
The LEDs are preferably infra red LEDs. 

The LEDs 24, 26, 28 are positioned on the pyramid side &ces and/or the angles of the 
pyramid side feces are such that for three degrees of freedom at least one receiver unit SO, 52 
on the headset always "sees" at least one LED. For six degrees of freedom each receiver 
"sees" three LEDs. Movement of the headset 40 when worn by a user is, of course, 
physically constrained within certain. 

It will be appreciated, therefore, that the axis of each pyramid 1 1 (the perpendicular from the 
pyramid base through the apex) extends, ideally, through the centre of the headset 40 when 
the latter is in its base position. 

Figure 1 1 is a plan view of one of the receiver units SO and Figure 12 is a perspective view 
of the receiver xmit of Figure 1 1. The two receiver units 50, 52 are identical. Each receiver 
unit has a body 53 in the form of a block having plain parallel side faces 54, 64, opposing 
upper and lower faces 56, 62 and front faces 58, 60. Each of these faces is generally planar 
and parallel to a vertical axis passing normal to the faces 54 and 64. Faces 56 and 62 are 
inclined inwardly towards one another by an angle a of 5° whilst the faces 58 and 60 form 
an angle p of 135*. 
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Each of the faces 54 to 64 has a respective planar photodetector A to F for detecting infrared 
light emitted by the LEDs on each of the transmitter units 10, 12. For ease of reference the 
corresponding photodetector references for the receiver unit 52 are shown in brackets in 
Figures 1 1 and 12 against the corresponding photodetector references of the receiver unit 50. 
The photodetectors generate output signals in response to detection of the infra red light and 
these output signals are processed by a processor circuit 100 connected both to the LED's and 
to the photodetectors. The angles of the feces 54 to 64 as mentioned above are such that face 
60 is at right angles to face 56 and face 58 is at right angles to face 62. The result of this is 
that the six photodetectors A to F form four sets or triplets of orthogonal detectors. As seen 
in Figures 1 1 and 12 these four triplets are ABD. ACE, FBD and FCE. As is mentioned 
above, two such receiver units 50. 52 are mounted on the headset 40 and as indicated in 
Figures 1 1 and 12 the receiver unit 52 has six photo receivers G to L. These form three sets 
or triplets of orthogonal detectors GHJ, GIK. LHJ and UK. Because, in use. the headset is 
higher than the transmitter units 10, 12 the receiver units 50. 52 are angled downwardly by 
typicaUy 45% towards the console 13 on which the transmitter units are mounted, although 
the angle may be varied depending on the distance of the user from the transmitter units 10, 
12. 

Each receiver unit 50, 52 is positioned on the headset 40 with the planes of the side faces 54, 
64 generally vertical. In addition, each receiver unit 50,52 is positioned on the headset 40 
so that it faces forward at an azimuth angle of 22.5' to the forward line of sight of the user 
when the latter is looking in a direction forward at 90' to the base line 14 of the transmitters 
10,12, as aresult of which the normals to the side faces 54. 64 of the two receiver units 50, 
52 subtend an angle of 135 ». as shown in Figure 13. 

In use, each LED ofthe transmitter units 10, 12 is pulsed in sequence, each LED transmittmg 
a burst of eight pulses of infra red light at 125KHz. Each pulse ofthe burst is therefore 4 
^secs with a pulse spacing of 4 pisecs. 



Figure 14 is a timing diagram showing the timing of the pulse bursts, LI being the 
U-ansmission for the first LED in the first transmitter unit 10 or 12, whichever is activated 
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first, and L6 being for the sixth LED in the other transmitter unit. A "dummy" transmission 
LO, in which none of the LEDs is activated precedes LI and a further "dummy" transmission 
L7 follows the pulse burst L6. Each transmission and dunmiy transmission occupies 64 
usees, the total transmission time for one cycle thus being 512 ^secs. 

The purpose of the dummy transmission LO is to null out any DC offset in the signals for 
subsequent processing of the signals by the processor circuit 100 whilst the dummy 
transmission L7 is to allow switching between the photodetectors A to F as discussed below 
without the switching interfering with the signal processing. 

In the receiver units 50, 52 each photodetector A to L is, in tum, switched on for one 
complete transmission cycle LO to L6 of the transmitter units 10, 12. Thus, whilst each 
photodetector A to L in tum is ON, all of the remaining photodetectors are OFF. 

Figure 15 is a cu-cuit diagram of the two receiver units 50, 52 and Figure 16 shows a block 
circuit diagram of the signal processing circuit ICQ. 

Referring firstly to Figure 15, each photodetector A to L of each receiver unit 50, 52 is shown 
controlled by a switch in the form of a field effect transistor (FET) 1 02. The photodetectors 
A to F are connected in parallel with one another, as are the photodetectors G to L. The 
photodetectors are conveniently photodiodes. 

Figure 17 shovre atiming diagram for activationof eachof the photodetectors A to L. As can 
be seen, for example, the switch 102 for the photodetector A is on for the transmission cycle 
LO to L6 and is switched OFF during the dummy transmission period L7. During this time 
all of the other switches 102 for the photodetectors of both receiver units are OFF. Whilst 
the switch 102 for photodetector A is switched OFF during the dummy transmission period 
L7, the switch 102 for photodetector B is switched ON during this dummy transmission 
period and is then switched OFF during the next following dummy transmission period L7. 
The other photodetectors C to L are each switched ON and then OFF in tum. It will be 
appreciated, therefore, that each photodetector A to L generates an output signal, for each 
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transmission period LI to L6, for the train of pulses received from each transmitter LED. 
Considering photodetector A, for example, this generates a sine wave signal (Figure 18) 
of the same frequency as the pulses transmitted by the transmitters 24, 26, 28 i.e. 125KHz. 
The amplitude of the sine wave signal Sa generated by the photodetector A in response to 
receipt of each of the pulse trains LI to L6 depends on the position and orientation of the 
photodetector A in space relative to the particular transmitter LED. If, for example, 
photodetector A is oriented such that it cannot "see" the transmitter LED transmitting the 
pulse train L3 then no output signal is generated. If, on the other hand, the photodetector A 
lies at right angles to the axis of the transmission cone of the LED transmitting the pulse train 
L3 then its output signal amplitude depends simply on the linear distance between the 
photodetector A and the relevant LED, the intensity of the received infrared light varymg in 
accordance with the inverse square law. 

Continuing to look at photodetector A, Figure 1 8 shows the typical signal generated in the 
photodetector A, in response to detection of the pulses transmitted by the transmitter units 
10, 12. As can be seen, the amplitude of the sign wave signal Sa generated by the 
photodetector A varies in dependence on the intensity at the optical detector A of the pulse 
train signal LI to L6 transmitted by the relevant transmitter LED of the transmitter units 10, 
12. Each of the photodetectors B to L produces a similar signal to signal but only the 
beginning of signal Sb (from photodetector B) is shown for clarity in Figure 18. 

Each of die signals from the photodetectors A to L is passed through a buffer amplifier 104, 
106 (one for each receiver unit 50, 52) and the outputs of the two buffer amplifiers 104, 106 
are passed through a multiplexer 1 08 to an automatic gain control (AGC) circuit 110. The 
multiplexer circuit 108 is tised to switch the AGC circuit 1 10 between the buffer amplifiers 
104, 106 to receive the successive signals from the photodetectors A to L. The gainof the 
AGC circuit 1 10 is adjusted in accordance with the intensity of tiie received signal to ensure 
that a reasonable signal level is provided at its output 

The signals from the AGC circuit 1 10 are then passed through a high pass filter 1 12 which 
has a lo^y frequency cutoff at about 1 OKHz. This removes any DC signals. 50Hz and 1 OOHz 
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interference signals which may be caused by daylight or artificial light. Figure 1 8 shows the 
output signal Shp generated at the output of the high pass filter 1 12 by the signal S j^ from 
photodetcctor A. 

The output Shp of the high pass filter is passed through a rectifier circuit 114 to give a 
rectified signal and then through an integrator/inverter circuit 116. Because the 
integrator/inverter circuit 116 adds the pulses from the rectifier, any random noise in the 
signal is cancelled out. The integrator/inverter circuit 116 ramps each series of pulses LI to 
L6 down to a level which depends on the amplitude of the pulses of signal Sr firom the 
rectifier circuit 1 14. The ramped signal S, is then held at its ramped level for a set period 
before being reset to 0 to begin integration of the next series of pulses from the rectifier 
circuit 114. The first pulse of each sequence of eight pulses LI to L6 is not used to 
contribute to the signal amplitude but is used to switch the multiplexer between the amplifiers 
104, 1 06 and to reset the integrator/inverter circuit 116. 

The output of the integrator/inverter circuit 1 16 is tiien applied to a buffer circuit 1 1 8 which 
comprises an inverter and level shift This shifts the level of the input signal by -5v, 
converts the signal to a positive going signal Sp firom -5v to +5v and applies this signal to an 
analogue to digital converter (ADC) 120. 

The last half pulse of each sequence of eight pulses of the transmissions LI to L6 is used to 
hold the amplitude of the signal firom the output signal firom the integrator/inverter circuit 1 1 6 
for sampling by the ADC 120. As a result, only 6.5 pulses firom each series of eight pulses 
is actually used in the subsequent processing. The ADC 120 samples the output Sp of the 
buffer amplifier 118 only during the "hold" period of each ramped output signal, i.e. it 
samples the signal once every 64 micro seconds and provides a 14 bit output signal which 
represents the amplitude level of the sampled hold signal. It will be appreciated, therefore, 
that for the periods LO to L6 of each transmission cycle the ADC 120 provides a first 14 bit 
signal representative of the background noise present during period LO and six, 14 bit signals 
representative of the amplitude of the infra red light signals received by the photodetector 
which is ON during the periods LI to L6 of that transmission cycle. With all twelve 
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photodetectors A to L this gives a total of eighty four 14 bit signals for one complete 
monitoring cycle. 

The signals ftom the ADC 120 are passed to a field programmable gate array 122 and a micro 
processor 124 which then processes the information. 

The first step in processing the signals from the ADC 120 is to subtract the signal LO from 
each of the signals LI to L6 of the transmission cycle. This removes any DC level from the 
signals to be processed. 

The fijTthcr processing, is described with reference to Figure 19 which is a chart of the 14 bit 
numbers for each combination of the photodetectors A to L and transmitters LI to L6. For 
example, the rectangle identified by the photodetector C and the transmission L2 is the 14 
bit digit representing the intensity of the light received by the photodetector C from the 
transmission L2. Similarly, the rectangle HLl is the 14 bit digit representing the intensity 
of the optical signal received by the photodetector H from the transmission LI. It wiU be 
recalled that the optical detectors are arranged in triplets with the optical detectors A to F 
arranged in four triplets ABD. ACE, FBD and FDE. Although the transmission LI occurs 
only once for the photodetectors A to F over a single transmission cycle, in order to facilitate 
the explanation the response of the four triplets of the photodetectors A to F to the 
transmission LI are shown in separate columns with the four triplet groups being identified 
respectively as a, b, c and d. The triplets for transmission LI are shown grouped by shaded 
cells in vertical columns. Thiis, the triplet ABD is identified in the first column, and so on. 
The same applies for transmitters L2 and L3. For example, ALl. refers to the 14 bit digit 
representing the intensity of the fight received by the photodetector A from the transmission 
L2 when it is processed as a signal fi»m the triplet ABD. ALU refers to the same 14 bit digit 
when it is processed as a signal from the triplet ACE. This applies also to the transmissions 
L2 to L6 and photodetectors G to L. 

The first upper left hand quadrant (photodetectors A to F and transmissions LI to L3) of 
Figure 19 represents the signals received by the right hand receiver unit 50 from the three 
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LEDs of the right transmitter unit 1 0. The upper right hand quadrant represents the signals 
received by the right hand receiver unit 50 from the left hand transmitter unit 12, the lower 
right quadrant represents the signals received by the left hand receiver unit 52 from the left 
hand transmitter unit 12 and the lower left quadrant represents the signals received by the left 
hand receiver unit 52 from the right hand transmitter unit 10. Since the processing of the 
signals in each quadrant is the same, only the processing of the signals for the upper left 
quadrant, as shown, is described. 

. Firstly, the micro processor 124 looks at the signals from each photodetector of a triplet, for 
each of the transmissions LI to L3. If the signal from any one of the photodetectors of a 
triplet is 0 or less than a preset threshold level for a transmission then all of the signals of that 
triplet for that transmission are ignored. For example, if each of the photodetectors A, B and 
. D of the triplet ABD provides a signal for each transmission LI and L2 which is above the 
: present threshold level but photodetector A does not provide a signal above this threshold for 
transmission L3, then not only is the signal from photodetector A ignored for transmission 
. L3 but the signals from photodetectors B and D for transmission L3 are also ignored. Only 
. . those signals from the triplet ABD for transmissions LI and L2 are taken for ftirther 
processing. 

If the 14 bit digit for each photodetector is represented by N„ where n is the cell reference 
then the amplitude of the signal received by photodetector C from transmitter LI is 
represented by Nctf 

For simplicity, if we assume that each 14 bit digit which represents a signal level below the 
preset threshold is 0, if N^li = 0 (i.e. the intensity of the light received by the photodetector 
A from the transmitter LI is below the preset threshold level) then the signals received by 
photodetectors B and D in the triplet ABD and the signals received by photodetectors C and 
E in the triplet ACE from the transmission LI are ignored. Thus, signals Nb^lh ^drlij ^cbu 
ai^d NEbLi ^1 ignored since the signal N^li for each of the triplets ABD and ACE is 0. 
This process is repeated for transmissions L2 and L3. However, it shoiild be appreciated that 
the signal received by photodetector A from transmission L2 may well be above the threshold 
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level in which case Nal2 will not be 0. Therefore, the signals from, for example, the 
photodetectors of the triplet ABD for the transmission L2 are not ignored (unless either of 
the signals received by the photodetectors B and D of this triplet ABD from transmission L2 
is 0 i.e. Nbl2 ot Ndl2 is 0. If we take the example where N^li and N^l: are both below the 
threshold this leaves the signals from the following triplets to be processed: 

For transmission LI : BDF and CDF. 

For transmission L2: ABD, ACE and CDF 

For transmission L3 : ABD, ACE, BDF and CDF. 

For transmission LI the signals from the triplets BDF and CDF are added i.e. the numbers 
Nbcli» Ndcli» NpcLi* NcdLi» NodL, andNpdLi are added to give a first summed signal SLl. 

This process is repeated for the numbers for transmissions L2 and L3 to provide further 
summed signals SL2 and SL3. The largest of these three signals 2L1, 2L2 and SL3 
indicates which of the transmissions LI to L3 of the right hand transmitter unit 1 0 provides 
the greatest intensity signal at the photodetectors A to F of the right hand receiver unit 50. 
If, for example, 2L2 is the largest of these three signals then the signals for the 
photodetectors of each available triplet for the transmission L2 are summed. Thus for the 
triplet ABD the signals N^au* '^Ban and l^oaLz are summed to provide a signal Sj^ABD. 
Equally, summed signals ^ljACE and S^CDF are also obtained for the transmission L2. 
The largest of these three signals detennines which of the triplets is used in the calculations 
to determine the orientation and position of the headset relative to the transmitter units 10, 
12. Having chosen the largest signal, eg EtaACE then the three ratios of each of the signals 
received by the photodetectors A, C and E to 2 ACE enable the calculation of the pointing 
angle (or "directional" vector) from the right hand receiver unit 50 to the right hand 
transmitter imit 10. 

The same calculations are performed for the remaining three quadrants of Figure 19 to give 
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the "directional" vectors from the right hand receiver unit 50 to the left hand transmitter unit 
12 and also from the left hand receiver unit 52 to both the right hand and left hand transmitter 
units 10, 12. The signal ratios thus obtained enable the 3-dimensionaI angle between the . 
boresight of the receiver units and the line from the receiver units to the transmitters to be 
measured. This gives the pointing angle of the headset in space relative to the transmitter 
units 10, 12. 

In order to determine the position of the headset in space relative to the console the 3- 
dimensional angle between the bore sight of each receiver unit and the line from the receiver 
unit to the transmitters needs to be obtained. To do this, the 14 bit numbers referred to above 
are processed in a similar manner to that described above but instead of the numbers being 
added vertically v^dth reference to Figure 19 they are added horizontally for each 
photodetector A to L. Looking firstly at photodetector A, again, if the 14 bit digit Nali=0 
then the signals received by photodetector A from the transmissions LI, L2 and L3 are 
ignored. 

If we assume, as described above, N^li and are both below the threshold then the signals 
from photodetectors A and B for the transmissions LI, L2 and L3 are ignored. Assuming, 
therefore, that each signal received by the photodetectors C to F for each of the transmissions 
LI to L3 is above the threshold then the signals for transmission LI received by the 
photodetectors C to F are summed to give a first summed signal 2L1c.f- This is repeated for 
the transmissions L2 and L3 to give sununed signals 2L2c.f ai^d SL3c-f- These signals are 
summed to provide a total summed signal SL1.3 and tiie ratios of the individual sununed 
signals to the total summed signal are then processed to provide the 3-dimensional angle 
between the boresight of each transmitter unit and the line from the transmitter unit to each 
receiver unit. Thus, the position and orientation of the headset in space relative to the 
transmitter units 10,12 can be determined. 

Since each triplet, whether it is a triplet of photodetectors of LED's, can only operate over 
a limited field of view, typically 75^ to 80° it is necessary to use several triplets to achieve 
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the required field of view for the system. In the azimuth direction a field of view in excess 
of 200° is needed and it is for this reason that two receiver units 50, 52 are mounted on the 
headset 40 as shown in Figure 13 which is a plan view of the two receiver units 50, 52 on the 
headset 40. Looking at the left hand receiver unit 52, since the side faces 54 and 64 are 
parallel the azimuth field of view "seen" by the triplet ABD, subtends an angle a , of 80\ 
Equally, the triplet FBD also subtends an angle 03 of 80"*. This means that there is a narrow 
horizontal region between these two triplets (and also between triplets ACE and CEF) which 
is not covered. However, since two such receiver units are provided on the headset at an 
angle of 135" to one another, as previously described, there is a degree of overlap. Figure 
20 shows the angles a, and aj with the corresponding angles a3 and of the right hand 
receiver unit superimposed. Angles a, and overlap by at least 25" and preferably 35% as 
do angles and a?, and angles a2 wid a^. Together, the receiver units provide an azimuth 
field of view of 215" with a 35** overlap. 

For elevation, the field of view need not be as great and a field of view of 80° is sufficient. 
This is provided by overlap of the elevational field of view of two triplets on each receiver 
unit. 
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Claims 

1 . A system for determining the relative positions of first and second objects in space 
in the azimuth and vertical directions wherein one of said objects is stationary and the other 
of said object is moveable in space, the system comprising: 

transmitter means on said first object for generating a radiation beam; 

receiver means on said second object for receiving radiation transmitted by said transmitter 
means; 

wherein either: 

a) said transmitter means comprises three transmitters in a fixed, spaced relationship 
to one another for generating respective radiation beams; or 

b) said receiver means comprises three receivers in a fixed, spaced relationship to one 
another for detecting said radiation; 

and wherein the or each said receiver has a plane of sensitivity such that the intensity of 
incident radiation is proportional to the cosine of the angle of incidence of said radiation; 

the system further comprising: 

means for monitoring said intensity of the radiation incident at tiie or each said receiver from 
the or each transmitter and generating a respective direction cosine signal proportional to said 
intensity; 

and micro processor means operable to determine fi-om said signals a pointing vector of said 
moveable body from said stationary body. 
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2. A system as claimed in claim 1, further comprising two said receiver means in fixed, 
spaced relationship to one another; 

wherein each said receiver means comprises three said receivers in fixed, spaced relationship 
to one another; 

said nionitoring means is operable to generate a respective direction cosine signal for the 
radiation incident at each said receiver from the or each said transmitter; 

and said micro processor means is operable to determine from said direction cosine signals 
both said pointing vector and a head-up vector of said moveable body, and thereby detemiine 
the orientation of said moveable body relative to said stationary body. 

3. A system as claimed in claim 2, wherein said transmitter means comprises three said 
transmitters in a fixed, spaced relationship to one another; 

said monitoring means is operable to generate a respective direction cosine signal for the 
radiation incident at each said receiver from each said transmitter; 

and said micro processor means is operable to determine from said direction cosine signals 
the position and orientation of said moveable body relative to said stationary body. 

4. A system as claimed in claim 1, further comprising two said transmitter means in 
fixed, spaced relationship to one another; 

wherein each said transmitter means comprises three said transmitters in fixed spaced 
relationship to one another; 

said monitoring meails is operable to generate a respective direction cosine signal for the 
radiation incident at the or each said receiver from each said transmitter; 



wo 96/35960 



PCT/GB96/01141 



31 

and said micro processor means is operable to determine from said direction cosine signals 
both said pointing vector and a head-up vector of said moveable body, and thereby determine 
the orientation of said moveable body relative to said fixed body. 

5. A system as claimed in claim 4, wherein said receiver means comprises three said 
receivers in a fixed, spaced relationship to one another for detecting said radiation; 

said monitoring means is operable to generate a respective direction cosine signal for the 
radiation incident at each said receiver from each said transmitter; 

and said micro processor means is operable to determine from said direction cosine signals 
the position and orientation of said moveable body relative to said stationary body. 

6. A system as claimed in any preceding claim wherein, in said transmitter means 
having three said transmitters, said transmitters are arranged with their axes of radiation 
orthogonal. 

7. A system as claimed in the preceding claim wherein, in said receivers means having 
three said receivers, said receivers are arranged with their planes of sensitivity orthogonal. 

8. A system as claimed in any preceding claim wherein the or each said receiver means 
comprises six said receivers arranged in four orthogonal sets of three. 

9. A system as claimed in any preceding claim, having two said receiver means 
positioned on said moveable body relative to one another to provide an azimuth field of view 
ofat least 200*. 

10. A system as claimed in any preceding claim having a single said transmitter and a 
plurality of said receivers wherein said micro processor means is operable to energise said 
transmitter for a pre-selected first time period and to monitor sequentially each said receiver 
during said time period thereby to obtain said direction cosine signals for each said receiver. 
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11. A system as claimed in any of claims 1 to 10 having a plurality of transmitters and 
a single receiver wherein said micro processor means is operable to energise said transmitters 
sequentially for a pre-selected time period and to monitor said receiver thereby to obtain said 
direction cosine signals for the radiation received by said receiver from each said transmitter, 

12. A system as claimed in any of claims 1 to 1 0 having a plurality of said transmitters 
and a plurality of said receivers wherein said micro processor means is operable to monitor 
sequentially each said receiver for a pre-selected time period and to energise sequentially said 
transmitters during said time period thereby to obtain said direction cosine signals for 
radiation received by each receiver from each transmitter. 

13. A system as claimed in any preceding claim wherein said radiation is pulsed infra-red 
radiation. 

14. A method of determining the relative positions of first and second objects in space 
in the azimuth and vertical directions wherein one of said objects is stationary and the other 
of said object is moveable in space, the method comprising: 

providing transmitter means on said first object for generating a radiation beam; 

providing receiver means on said second object for receiving radiation transmitted by said 
transmitter means; 

wherein either: 

a) said transmitter means comprises three transmitters in a fixed, spaced relationship 
to one another for generating respective radiation beams; or 

b) said receiver means comprises three receivers in a fixed, spaced relationship to one 
another for detecting said radiation; 
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and wherein the or each said receiver has a plane of sensitivity such that the intensity of 
incident radiation is proportional to the cosine of the angle of incidence of said radiation; 

the method further comprising: 

monitoring said intensity of the radiation incident at the or each said receiver from the or 
each transmitter and generating a respective direction cosine signal proportional to said 
intensity; 

and determining from said signals a pointing vector of said moveable body from said 
stationary body. 

15. A method as claimed in claim 14, further comprising providing two said receiver 
means in fixed, spaced relationship to one another; 

wherein each said receiver means comprises three said receivers in fixed, spaced relationship 
s to one another 

and wherein the method comprises: 

monitoring said intensity of the radiation incident at each said receiver from the or each 
transmitter and generating a respective direction cosine signal for the radiation incident at 
each said receiver from the or each said transmitter; 

and determining from said direction cosine signals both said pointing vector and a head-up 
vector of said moveable body, and thereby detemiine the orientation of said moveable body 
relative to said stationary body. 

16. A method as claimed in claim 15, wherein said transmitter means comprises three 
said transmitters in a fixed, spaced relationship to one another; 



wo 96/35960 



PCT/GB96/01141 



34 

tne method comprising: 

generating a respective direction cosine signal for the radiation incident at each said receiver 
from each said transmitter; 

and determining from said direction cosine signals the position and orientation of said 
moveable body relative to said stationary body. 

17. A method as claimed in claim 1 4, comprising providing two said transmitter means 
in fixed, spaced relationship to one another, wherein each said transmitter means comprises 
three said transmitters in fixed spaced relationship to one another; 

generating a respective direction cosine signal for the radiation incident at the or each said 
receiver firom each said transmitter; 

and determining from said direction cosine signals both said pointing vector and a head-up 
vector of said moveable body, and thereby detemiine the orientation of said moveable body 
relative to said fixed body. 

18. A method as claimed in claim 1 7, wherein said receiver means comprises three said 
receivers in a fixed, spaced relationship to one another for detecting said radiation; 

and wherein the method comprises: 

generating a respective direction cosine signal for the radiation incident at each said receiver 
from each said transmitter; 

and determining from said direction cosine signals the position and orientation of said 
moveable body relative to said stationary body. 



19. A method as claimed in any of claims 14 to 1 8 wherein, in said transmitter means 
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having three said transmitters, said transmitters are arrfjiged with their axes of radiation 
orthogomd. 

20. A method as claimed in any of claims 14 to 19 wherein, in said receivers means 
having three said receivers, said receivers are arranged with their planes of sensitivity 
orthogonal. 

21. A method as claimed in any any of claims 14 to 20 wherein the or each said receiver 
means comprises six said receivers arranged in four orthogonal sets of three. 

22. A method as claimed in any of claims 14 to 21 having two said transmitter means 
positioned on said moveable body relative to one another to provide an ayimiith field of view 
ofatleast200^ 

23. A method as claimed in an}' of claims 14 to 22 having a single said transmitter and 
a plurality of S£dd receivers, tiie method comprising: 

energising said transmitter for a pre-selected first time period and monitoring sequentially 
each said receiver during said time period thereby to obtain said direction cosine signals for 
each said receiver. 

24. A method as claimed in any of claims 14 to 22 having a plurality of transmitters and 
a single receiver, the method comprising energising said transmitters sequentially for a pre- 
selected time period and monitoring said receiver thereby to obtain said direction cosine 
signals for the radiation received by said receiver from each said transmitter. 

25. A method as claimed in any of claims 14 to 22 havmg a plurality of said transmitters 
and a plurality of said receivers, the method comprising monitoring sequentially each said 
receiver for a pre-selected time period and energising sequentially said transmitters during 
said time period thereby to obtain said direction cosine signals for radiation received by each 
receiver from each transmitter. 



wo 96/35950 PCT/GB96/01141 

36 

26. A method as claimed in any of claims 14 to 25 wherein said radiation is pulsed infra- 
red radiation. 
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